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Abstract 



The method involves a change from a base reference to a tool clamp reference interpolation and back 
again. It establishes a transformation between a tool clamp coordinate system (WZ) in the robot hand (TCP), 
and a base coordinate system (BA) in the tool piece (W). Mathematical interpolation procedures are applied 
to the tool clamp reference and then inverted, before the transformation from cartesian to axial coordinates. 
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(3) Verfahren und Vorrichtung zum Uberschieifen bei numerisch gesteuerten Maschinen 



(g) Ein Verfahren zum OberschJeifen bei Wechsel von bahn- 
bezogener auf greiferbezogene Interpolation und umge- 
kehrt, ist so ausgebildet, daS der Ursprung des Greiferkoor- 
dinatensystems in den TCP der Roboterhand, das Bastskoor- 
dinatensystem in das ortsfeste Werkzeug gelegt wird und 
daS greiferbezogene CP-Satze greiferbezogen aufbereitet 
und interpoliert und vor der Ruckwartstransformation inver- 
tiert werden. Damit lassen sich die Ubergange gut beherr- 
schen. 
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Beschreibung 

Bei der numerisch gesteuerten Bearbeitung von Werkstticken durch eine mehrachsige Maschine, z. B. einen 
Roboter kann es entscheidende technologische Vorteile bringen, wenn gegeniiber der herkdmmlichen Bearbei- 

5 tung bei der das Werkzeug von der Roboterhand uber ein ortsfestes Werkstuck gefiihrt wird, das Werkzeug 
ortsfest angebracht und das Werkstuck von der Roboterhand Ober das ortsfeste Werkzeug geftthrt wird. Fttr die 
letztgenannte Bearbeitungsart wird durch die Robotersteuerung eine sogenannte greiferbezogene Interpolation 
vorgenommen, wogegen bei der herkdmmlichen Flihrung des Werkzeuges Uber ein ortsfestes Werkstuck 
basisbezogen interpoliert wird. 

io Die greiferbezogene Interpolation bringt dem Anwender mehrere Vorteile, u. a. wird der Aufbau einfacher, 
man benotigt nur noch einen Greifer und spart die Einspannvorrichtung fur das Werkstuck, ein ortsfestes 
Werkzeug unterliegt weniger Beschrankungen in Gewicht und Abmessungen und die Versorgungseinrichtun- 
gen fur SchweiBdraht, Kuhlmittel werden deutlich einfacher, da sie nicht tiber die Roboterarme zugefuhrt 
werden miissen. Zweitens erzielt man kurzere Taktzeiten, da man das Werkstuck in einem Arbeitsgang ohne 

15 Anhalten und Umgreifen heranbringen, bearbeiten und wieder abtransportieren kann. 

Diese Vorteile der greiferbezogenen Interpolation kommen insbesondere beim BahnschweiBen und Kleben 
wahrend einer kontinuierlichen Bahnbewegung zum tragen. Hingegen lassen sich Transportaufgaben vor und 
nach der Bearbeitung in der Regel einfacher in einem ortsfesten Basiskoordinatensystern durchfuhren. FOr eine 
optimale Bearbeitung ist es daher wOnschenswert, daB zwischen greifer- und basisbezogener Interpolation 

20 standig gewechselt werden kann. Damit bei diesen Wechseln keine ruckartigen Bewegungsablaufe auftreten, 
mussen die Obergange zwischen greifer- und basisbezogener Interpolation und umgekehrt weich ausgefUhrt 
werden. 

Bei der basisbezogenen Interpolation lassen sich weiche Obergange zwischen zwei Verfahrsatzen durch ein 
Oberschleifverfahren wie es beispielsweise aus der europaischen Patentanmeldung 0449039 (dort mit weiteren 
25 Nachweisen) bekannt ist, erzeugen. 

Eine flexible Handhabung der Obergange zwischen basis- und greiferbezogener Interpolation, insbesondere 
das Oberschleifen ist jedoch nicht moglich. 

Aufgabe der Erfindung ist es daher, ein einfaches Verfahren fOr den Obergang zwischen greifer- und basisbe- 
zogener Interpolation und umgekehrt anzugeben. 
30 Diese Aufgabe wird durch die Merkmale der Patentanspruche gelost 

Ein Ausfuhrungsbeispiel der Erfindung wird im folgenden anhand der Zeichnung naher eriautert Dabei 
zeigen: 

Fig. 1 bis Fig. 4 Veranschaulichung der greiferbezogenen Interpolation, 

Fig. 5 die Fuhrung eines an einer Roboterhand angebrachten Werkzeuge uber einem ortsfesten Werkstuck, 
35 Fig. 6 die Fuhrung eines an einer Roboterhand angebrachten Werkstucks uber einem ortsfesten Werkzeug, 
Fig. 7 ein basisbezogenes Oberschleifen mit Wechsel des Bezugsystems, 
Fig. 8 ein Oberschleifen bei Obergang auf greiferbezogene Interpolation, 

Fig. 9 ein Oberschleifen beim Obergang von greiferbezogener auf basisbezogene Interpolation, 
Fig. 10 Transformation einer Werkzeugposition WZ und der Geschwindigkeitsvektoren V und omega zwi- 
40 schen zwei Koordinatensystemen Bl und B2, 

Fig. 1 1 Transformation der Stiitzpunkte und Oberschleifpunkte, 

Fig. 12 Transformation einer translatorischen Geschwindigkeit zwischen bewegten Koordinatensystemen 
und 

Fig. 13 Transformation einer Winkelgeschwindigkeit zwischen bewegten Koordinatensystemen, 

45 Bevor auf das eigentliche Oberschleifverfahren eingegangen wird, sei anhand der Fig. 1 bis 4 zunachst das 
Problem der greiferbezogenen Interpolation veranschaulicht. 

Die Frage, wie sich die Roboterhand andern muB, wenn man nicht das Werkzeug sondern das Werkstuck 
fiihrt, aber die gleiche Relativbewegung zwischen beiden erhalten mochte entzieht sich sehr schnell dem 
Vorstellungsvermdgen. An einem einfachen zweidimensionalen Beispiel, wie es anhand der Fig. 1 bis 4 darge- 

50 stellt ist, lassen sich einige grundsatzliche Eigenheiten gut klarmachen. Fig. 1 zeigt ein Werkstuck, dessen Kontur 
aus geraden StUcken und Kreisabschnitten zusammengesetzt isL Spannt man dieses Werkstuck fest auf, so 
entspricht die gezeichnete Kontur der Bahn der Werkzeugspitze. Ist das Werkzeug rotationssymmetrisch, laBt 
sich die Kontur mit einer reinenTranslationsbewegung abfahiren. 

Ein gerichtetes Werkzeug muB dagegen immer eine bestimmte Orientierung zur Kontur einhalten. Die 

55 Anderung der Orientierung ist anhand von Fig. 2 durch die an der Kontur angreifenden kleinen Pfeile verdeut- 
licht. Setzt man das Werkzeug fest und bewegt das Werkstuck, zeigen diese beiden Falle sehr verschiedene 
Auswirkungen auf die Bewegung der Roboterhand. In Fig. 3 wird das Werkstuck von der Roboterhand im 
Bezugspunkt ( = Greifpunkt) gegriffen und es wird die Bewegung dieses Punktes betrachtet, die notig ist, um die 
Kontur am feststehenden Werkstuck entlang zu fiihren. 

60 Bei rotationssymmetrischem Werkzeug kann die Orientierung des Werkstucks stets beibehalten werden, 
lediglich der Kontakt zwischen Kontur und Werkzeug ist sicherzustellen. Die resultierende Bewegung entsteht 
dann einfach durch Spiegelung der Werkstiickkontur in der Mitte der Verbindungslinie zwischen Bezugspunkt 
und Werkzeug. In diesem Fall laBt sich eine greiferbezogen programmierte Bahn offenbar sehr einfach umrech- 
nen. Man muB nur alle Stutzpunkte der Bahn spiegeln und kann Abfolge und Lange der Bahnsegmente 

65 unverandert beibehalten. 

Ein gerichtetes Werkzeug erfordert dagegen eine Umorientierung des Werksttlcks wahrend der Bewegung, 
und die Oberlagerung von Verschiebung und Drehung erzeugt eine sehr viel komplexere Bahn des Greifpunk- 
tes, wie sie in Fig. 4 dargestellt ist. 
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Die Bahn besteht zwar nach wie vor aus geraden Stucken und Kreisabschnitten, deren Anzahl, Verteilung und 
Lange hat sich aber deutlich geandert. An alien Ecken der Kontur verharrt das Werkzeug eine Zeit lang am 
gleichen Punkt, wahrend das Werkstuck urn diesen Punkt schwenkt An Punkt A steht dagegen der Greifer still, 
andert lediglich seine Orientierung, wahrend der groBe Radius des Werkstucks am Werkzeug entlang gefuhrt 
wircL 5 

Durch Ecken in der Kontur entstehen dieselben Probleme, wie bei basisbezogener Interpolation mit einem 
raumlich ausgedehnten Werkzeug. Erstens muB ein zusatzliches Bahnsegment eingefugt werden, das lediglich 
der Umorientierung des Werkstucks dient, zweitens kann diese Umorientierung nicht belie big schnell erfolgen. 
Je gr6Ber der Abstand zwischen Greifpunkt und Werkzeug, desto weiter wird der Weg, den der Greifer 
zuriickzulegen hat. Da die Bahngeschwindigkeit begrenzt ist, muB hierfiir eine ausreichend groBe Zeitspanne io 
eingeplant werden. 

In den gezeigten Beispielen werden gerade Stucken auf gerade Stiicke abgebildet und Kreissegmente auf 
Kreissegmente. Dies liegt jedoch nur an der streng konstant gehaltenen Orientierung des Werkzeugs zur Kontur 
und kann nicht verallgemeinert werden. Im iibrigen ist festzuhalten, daB sich die Geschwindigkeit des Greifers 
auf den Kreissegmenten durch die Abbildung andert (am deutlichsten an Ecken). Die technologisch wichtigen 15 
Geschwindigkeiten konnen jetzt nur noch greiferbezogen bestirnmt werden und zwar aus der Bewegung des 
Werkzeugs relativ zum werkstiickfesten Koordinatensystem. 

Bei der Annaherung an das ortsfeste Werkzeug und nach Ende der Bearbeitung bewegt man das Werkstuck 
sinnvollerweise relativ zu einem ortsfesten Koordinatensystem. Man muB daher zwischen beiden Interpolations- 
arten schnell und mdglichst auch flieBend mit Hilfe eines Uberschleifsatzes umschalten konnen. 20 

Anhand der Fig. 5 und 6 werden im folgenden die wesentlichen Grundlagen der Interpolation beschrieben. 
Fig. 5 zeigt die Fiihrung des Werkzeugs iiber ein ortsfestes Werkstuck. Die Bewegung des an der Roboterhand 
befestigten Werkzeugs W iiber ein ortsfest angebrachtes Werkstuck S stellt den "Normalfall" dar, der hier kurz 
rekapituliert werden soil. 

Bei einer bekannten Robotersteuerung kann die Bahn des Werkzeugpunktes, dargestellt durch das Koordina- 25 
tensystem WZ relativ zu einem frei wahlbaren werkstiickfesten Basiskoordinatensystem BA angegeben werden. 
Die Steuerung rechnet diese selbstandig um und zwar zunachst auf Weltkoordinaten WE (Inertialkoordinaten), 
dann auf RoboterfuBkoordinaten RO, schlieBlich auf das roboterinterne Koordinatensystem IRO. Daraus wie- 
derum ermittelt die Rucktransformation die einzustellenden Achssollwerte. Vom Programmierer werden also 
das Basiskoordinatensystem BA relativ zum Inertialkoordinatensystem WE sowie einige ausgezeichnete Bahn- 30 
punkte (wobei ein Bahnpunkt jeweils durch Position und Orientierung des Tool-Center-Points also der Roboter- 
hand bestirnmt ist) relativ zu dem Basissystem BA. Die Interpolation arbeitet in Basiskoordinaten und erganzt 
somit in Echtzeit die fehlenden Bahnpunkte. Jeder Bahnpunkt muB auf Weltkoordinaten BE umgerechnet 
werden. Die dazu anzuwendende Gleichung erhalt man durch Verfolgen der Transformationskette (Gleichung 

0 35 

Twz^ * T BA WE Twz ba GL 1 

wobei T eine Trans forma tionsmatrix ist, die die Position und Orientierung beschreibt. Das Ergebnis erlaubt die 
Berechnung der Achssollwerte gemaB Gleichung 2 40 

0 = K-'(Twz IRO ) - K-HCTro^Tiro^'^wz^) GL 2 

wobei K~ 1 flir die Rucktransformation steht 

In Fig. 6 ist die Fiihrung des Werkstucks iiber einem ortsfesten Werkzeug dargestellt 45 
In diesem Fall ist das Werkstuck S fest mit der Roboterhand verbunden und wird iiber das stationare 
Werkzeug W, z. B. eine Klebediise oder eine SchweiBvorrichtung gefuhrt Man mochte die Bahn nach wie vor 
iiber einen werkstiickfesten Koordinatensystem beschreiben und interpolieren. Da aber jetzt das Werkstuck 
bewegt wird, muB sich auch das Bezugssystem mitbewegen. 

Eine einfache und universelle Losung des Problems besteht darin, das Basissystem BA in das ortsfeste 50 
Werkzeug W zu legen und die Bahn als die "Bewegung" dieses Basissystems BA relativ zum Greifpunkt d. h. zum 
Greiferkoordinatensystem auf dem Werkstuck S zu definieren. Die Bahn des Werkzeugs W wird also in 
werkstiickfesten Koordinaten beschrieben. Dies laBt sich durch eine Inversion der basisbezogenen Darstellung 
erreichen. Anstelle von Twz BA wird nun Tba wz = (Twz BA ) -1 verwendet. Durch Verfolgen der Transforma- 
tionskette erhalt man Gleichung 3 55 

Twz we Tba = Tba^ - Twz WE = Tea we (Tba wz ) " 1 GL 3 

Die Position des Greiferkoordinatensystems WZ dargestellt in Weltkoordinaten, Twz^. wird genauso wei- 
terverarbeitet, wie bei basisbezogener Programmierung. 60 

Ist die Bahn in greiferbezogenen Koordinaten angegeben, muB man sie demnach zunachst in diesen Koordina- 
ten interpolieren, was sich nicht von einer Interpolation in einem ortsfesten Basissystem unterscheidet Das 
Ergebnis Tba wz ist jedoch in jedem Interpolationstakt zu invertieren, noch vor der Umrechnung auf Weltkoor- 
dinaten Twz^. Im iibrigen sind beide Interpolationsverfahren vollig gleich. 

Greiferbezogene PTP-Satze sind entsprechend zu behandeln. Der Zielpunkt eines solchen Satzes liegt eben- 65 
falls als Tba w vor, wird daher zunachst invertiert, dann in roboterinterne kartesische Koordinaten transfor- 
miert und schlieBlich in Achssollwerte. Hier entsteht nur in der Satzaufbereitung ein geringer Zusatzaufwand, 
die achsspezifische Interpolation kann unverandert bleiben. 
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Nach diesen Vorbemerkungen wird nun im folgenden auf das erfindungsgemaBe Verfahren eingegangen. 

Satzubergange und Oberschleifen 

5 . Die greiferbezogene Interpolation wird stets nur einen Ausschnitt aus einer langeren Bewegungsfolge darstel- 
len. Transportvorgange vor und nach der Bearbeitung lassen sich in der Regel besser in ortsfesten Koordinaten 
programmieren und interpolieren. Die ObergSnge zwischen basisbezogener und greiferbezogener Interpolation 
sollten fur den Anwender ebenso flexibel zu handhaben sein wie ein Wechsel des ortsfesten Basissys terns, 
insbesondere sollte auch ein Oberschleifen moglich sein. 

io Eine allgemeine Losung dieses Problems muB folgende Punkte berucksichtigen: 

1. Satztyp vor und hinter dern Obergang (PTP, CP wie LIN, CIRC), 

2. Wechsel der ortsfesten Basis, 

3. Obergang von basis- auf greiferbezogene Interpolation oder umgekehrt. 
Fur jeden der genannten Faile ist f estzulegen: 



15 



1. Art des Oberschleifsatzes (PTP oder CP), 

2. Bezugssystem des Oberschleifsatzes, 

20 3. Bestimmung von Beginn und Ende des Oberschleifsatzes, 

4. Beschaffung und Transformation der Randbedingungen, 

5. Synchronisation zwischen Preparation und Interpolation, 

6. Behandlung von Liicken und Relativbewegungen, 

7. Auswirkung auf Technologiefunktionen (z. B. SYNACT). 



25 



30 



Die meisten Anderungen fallen in der Bewegungsplanung an, und zwar bei der Anpassung der Start- und 
Zielpunkte der Einzel- und Zwischensatze. 

Basisbezogenes Oberschleifen 



Zur Verdeutlichung wird die Aufbereitung eines gewohnlichen Satziibergangs vom Typ LIN-LIN, mit Wech- 
sel des ortsfesten Bezugs systems, kurz rekapituliert (Fig. 7). Der letzte noch im alten Bezugssystem Bl program- 
• mierte Bewegungssatz (PI — P2) sei mit "Vorgangersatz" bezeichnet, der anschlieBende, dessen Zielpunkt P3 im 
System B2 definiert ist, mit "Folgesatz". 
35 Der Obergang auf den Folgesatz erfordert: 

1. Erkennungdes Bezugssystem- Wechsels, 

2. Transformation des Startpunkts des Folgesatzes (P2) in das neue Bezugssystem, 

3. Aufbereitung des Folgesatzes (als Einzelsatz), 

40 4. Bestimmung des Oberschleif-Beginns im Vorgangersatz anhand des programmierten Oberschleifkrite- 

riums (in Fig. 7) das Wegkriterium SAPO.DIS), 

5. Berechnung der Position und Geschwindigkeit (translatorisch und rotatorisch) zu Beginn des Oberschlei- 
fens (Wl, zunachst im Bezugssystem Bl), 

6. Transformation von Position und Geschwindigkeiten in das Bezugssystem B2, 

45 7. Bestimmung des Oberschleif-Endes anhand des Oberschleif-Beginns und einer Weg-Zeit-Symmetriebe- 

dingung, 

8. Berechnung der Position und Geschwindigkeiten am Ende des Oberschleifens (ira Bezugssystem B2), 

9. Aufbereitung des Oberschleifsatzes im Bezugssystem B2. 

50 Wie die folgenden Abschnitte zeigen werden, kommt man bei einem Obergang auf greiferbezogene Interpola- 
tion oder umgekehrt mit wenigen Erweiterungen aus, die im wesentlichen die Transformation der StUtzpunkte 
betreffen. 



Obergang von basisbezogener auf greiferbezogene Interpolation 

55 

b K{ Der qualitative Ablauf der Satzaufbereitung laBt sich anhand eines einfachen Beispiels diskutieren, bei dem die 
^'^•Orientierung des Greifers konstant bleibt (Fig. 8). Die Annahme konstanter Orientierung dient nur der besseren 
✓ Obersicht bei der zeichnerischen Darstellung, die nachfolgend beschriebenen Algorithmen gelten auch ohne 
diese Einschrankung. 

60 Programmiert seien die Punkte PI, P2 und P3 sowie ein Oberschleifkriterium, durch das der Beginn des 
Oberschleifens Wl festgelegt ist. Da jeder Satz durch die Angabe seines Zielpunktes definiert wird, ist der Punkt 
P2, an dem der Obergang stattfindet, noch in einem ortsfesten Koordinatensystem programmiert Sollte die 
Bearbeitungsaufgabe es nicht zulassen, daB im Folgesatz (P2— P3) sofort eine Bearbeitung stattfindet, muB der 
Anwender den Beginn der Kontur durch einen weiteren, greiferbezogenen Punkt P3' definieren. Am prinzipiel- 

65 len Ablauf andert sich dadurch nichts. 

Die greiferbezogene Interpolation zwingt dem Bezugssystem BA (SBASE) eine bestimmte Lage auf, namlich 
im ortsfesten Werkzeug. Da die Annaherung moglicherweise in einem anderen Bezugssystem einfacher zu 
programmieren ist, wird der allgemeine Fall betrachtet, daB beim Obergang auf greiferbezogene Interpolation 
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gleichzeitig das Bezugssystem gewechseit wird (durch Zuweisung eines neuen Wertes an $BASE). Start- und 
Zielpunkt des Vorgangersatzes sowie der Beginn des Oberschleifens (PI, P2 und Wl) sind somit zunachst einmal 
im ortsfesten Bezugssystem BEZ bekannt Der Zielpunkt P3 des Foigesatzes definiert dagegen die Position des 
Bezugssystems BA relativzum Greiferkoordinatensystem WZ. 

Fur die weitere Diskussion muB man sich noch einmal klarmachen, daB der Obergang zur greiferbezogenen 5 
Interpolation einen Wechsei auf eine andere Sichtweise der "Bahn" darstellt: anstelle der Bahn des Greifers im 
ortsfesten Bezugssystem wird nun die Bahn des Werkzeugs (Bezugssystem BA) im Greiferkoordinatensystem 
beschrieben. Beide Blickwinkel existieren vollig gleichberechtigt nebeneinander, zu jedem Zeitpunkt kann man 
sowohl die eine als auch die andere Bahn angeben und Bahnpunkte ineinander umrechnen. Selbstverstandlich 
bleibt auch der Greifer an Punkt P2 nicht stehen, sondern bewegt sich wie angedeutet nach links unten weiter. 10 
Die "Bahn des Greifers aus Sicht des Werkzeugs" ist so eingezeichnet, wie sie ein ortsfester Beobachter sehen 
wiirde, 

Ein auf dem Greifer sitzender Beobachter wiirde dagegen feststellen, wie das Werkzeug sich an die Kontur 
annahert, in Richtung auf P3 schwenkt und an der Kontur entiangfahrt, dargestellt als "Bahn des Werkzeugs aus 
Sicht des Greifers". Da fur das Beispiel konstante Orientierung vorausgesetzt wurde, laBt sich diese Bahn sehr 15 
einfach durch Punktspiegelung konstruieren (vgl. oben). Beide Bahndarstellungen sind fur sich genommen stetig. 

Verbindet man beide Einzelsatze ohne Uberschleifen, erfolgt der Obergang im Stillstand genau zu dem 
Zeitpunkt an dem der Greifer den Punkt P2 erreicht. Fugt man dagegen einen Oberschleifsatz ein, kann man 
sowohl zu Beginn als auch am Ende des Oberschleifens umschalten, wobei an dieser Steiie nicht nur die Position, 
sondern auch die Geschwindigkeiten zu transformieren sind. 20 

Zugunsten einer moglichst einheitlichen Behandlung aller Oberschleifvorgange sollte der Zwischensatz be- 
reits im Koordinatensystem des Foigesatzes prapariert und interpoliert werden, d. h. der Obergang erfolgt 
bereits zu Beginn des Oberschleifens, am Punkt Wl bzw. Bl. Eine Ausnahme von dieser Regel machen nur 
PTP-CP-Oberschleifsatze, da diese grundsatzlich achsspezifisch aufbereitet werden mussen. 

Die relativ einfache zeichnerische Darstellung darf nicht zu der Annahme verleiten, daB ein Oberschleifvor- 25 
gang, der basisbezogen als LIN-LIN-Obergang behandelt werden kann, auch in greiferbezogenen Koordinaten 
diese einfache Form hat Nur im Sonderfall konstanter Orientierung werden Geradenstucke immer auf Gera- 
denstucke abgebildet Demnach muB ein greiferbezogen aufbereiteter Oberschleifvorgang in der Regel aus zwei 
Parabelabschnitten zusammengesetzt werden, um Stetigkeit aller skalaren und vektoriellen Geschwindigkeiten 
zu gewahrleisten. 30 

Die nachfolgend qualitativ angegebenen Algorithmen stimmen mit den basisbezogenen, bereits vorhandenen 
Versionen iiber weite Strecken uberein. 



Aufbereitung CP-CP 

35 

Dieser Fall entspricht weitgehend der Skizze in Fig. 8. Folgesatz und Oberschleifsatz mussen greiferbezogen 
(relativ zum Greiferkoordinatensystem WZ) aufbereitet werden. Alle fehlenden Stutzpunkte und Geschwindig- 
keiten sind durch Frame-Umrechnung zu beschaffen. 

1. Zielpunkt des Foigesatzes als greiferbezogen erkennen. 40 

2. Startpunkt des Foigesatzes auf Greiferkoordinaten umrechnen: 

a) Position von Bezugssystem BEZ in Bezugssystem BA transformieren, 

b) Ergebnis invertieren. 

3. Folgesatz greiferbezogen aufbereiten. 

4. Beginn des Oberschleifens im Vorgangersatz berechnen und transformieren: 45 

a) Oberschleifkriterium auswerten, Position und Geschwindigkeiten berechnen (Wl relativ zu BEZ), 

b) ins Bezugssystem BA transformieren. 

c) Ergebnis invertieren. 

5. Ende des Oberschleifens berechnen: 

Oberschleifkriterium greiferbezogen auswerten. Position und Geschwindigkeiten berechnen (B2 relativ zu 50 
WZ). 

6. Oberschleifsatz greiferbezogen aufbereiten. 

Aufbereitung PTP-PTP 

55 

Hier ist der Zielpunkt des Foigesatzes in kartesischen Koordinaten, bezogen auf den Greifer, gegeben. Ziel 
der Urnrechnungen ist jedoch ein achsspezifischer Folgesatz und Oberschleifsatz. 

1. Zielpunkt des Foigesatzes als greiferbezogen erkennen. 

2. Zielpunkt des Foigesatzes auf achsspezifische Koordinaten umrechnen: 60 

a) Zielpunkt invertieren (ergibt Darstellung relativ zu BA), 

b) Ergebnis in roboterinterne Koordinaten transformieren (BA — •* IRO), 

c) sowie in achsspezifische Darstellung umrechnen (Rucktransformation). 

3. Folgesatz achsspezifisch aufbereiten. 

4. Beginn des Oberschleifens im Vorgangersatz berechnen: 65 
Oberschleifkriterium achsspezifisch auswerten. Position und Geschwindigkeiten berechnen. 

5. Ende des Oberschleifens berechnen: 

Oberschleifkriterium achsspezifisch auswerten, Position und Geschwindigkeiten berechnen. 
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6. Oberschleifsatz achsspezifisch aufbereiten. 

Der Startpunkt des Folgesatzes bedarf in diesem Fall keiner weiteren Bearbeitung, da er bei Aufbereitung des 
PTP- Vorgangersatzes bereits in achsspezifische Koordinaten umgerechnet wurde, 

5 

Aufbereitung CP-PTP 

Wie im Fall PTP-PTP ist der Zielpunkt des Folgesatzes in kartesischen Koordinaten, bezogen auf den Greifer, 
programmiert Berechnet werden soli ein achsspezifischer Folgesatz und Oberschleifsatz. Der Startpunkt des 
io Folgesatzes ist in einem ortsfesten Koordinatensystem gegeben. 

1. Zielpunkt des Folgesatzes als greiferbezogen erkennen. 

2. Start- und Zielpunkt des Folgesatzes auf achsspezifische Koordinaten umrechnen: 

a) Startpunkt aus dem ortsfesten Bezugssystem in roboterinterne Koordinaten transformieren (BEZ — * 
is IRO), 

b) und in achsspezifische Darstellung umrechnen (Riicktransformation). 

c) Zielpunkt invertieren (ergibt Darstellung relativ zu B A), 

d) Ergebnis in roboterinterne Koordinaten transformieren (BA— * IRO), 

e) sowie in achsspezifische Darstellung umrechnen (Rucktransformation). 
20 3. Folgesatz achsspezifisch aufbereiten. 

4. Beginn des Oberschleifens berechnen: 

a) Oberschleifkriterium basisbezogen auswerten, zugehorige Position berechnen (Wl relativ zu BEZ), 
auBerdem leicht verschobene, benachbarte Position. 

b) in roboterinterne Koordinaten transformieren (BEZ — ► IRO), 

25 c) sowie in achsspezifische Darstellung umrechnen (Riicktransformation), 

d) Mit Hilfe der zweiten Position achsspezifische Geschwindigkeiten bestimmen (numerische Differentia- 
tion). 

5. Ende des Oberschleifens im Folgesatz berechnen: 

Oberschleifkriterium achsspezifisch auswerten. Position und Geschwindigkeiten berechnen. 
30 6. Oberschleifsatz achsspezifisch aufbereiten. 

Aufbereitung PTP-CP 

Hier ist der Folgesatz greiferbezogen, der Oberschleifsatz achsspezifisch aufzubereiten. Der Zielpunkt des 
35 Vorgangersatzes, also der Startpunkt des Folgesatzes, Iiegt mindestens in achsspezifischen Koordinaten vor. Die 
einzelnen Arbeitsschritte: 

1 . Zielpunkt des Folgesatzes als greiferbezogen erkennen. 

2. Startpunkt des Folgesatzes auf Greiferkoordinaten umrechnen: 

40 a) Achsspezifische Darstellung in roboterinterne kartesische Koordinaten transformieren (IRO), oder pro- 

grammierte kartesische Darstellung verwenden, sofern vorhanden. 

b) in das neue Bezugssystem umrechnen (IRO — * BA bzw. BEZ — B A), 

c) Ergebnis invertieren. 

3. Folgesatz greiferbezogen aufbereiten. 

45 4. Beginn des Oberschleifens im Vorgangersatz berechnen: 

Oberschleifkriterium achsspezifisch auswerten, Position und Geschwindigkeiten berechnen. 
5. Ende des Oberschleifens berechnen: 

a) Oberschleifkriterium greiferbezogen auswerten, zugehorige Position berechnen (B2 relativ zu WZ), 
auBerdem leicht verschobene, benachbarte Position. 
50 b) Beide Positionen invertieren (ergibt Darstellung relativ zu B A), 

c) in roboterinterne Koordinaten transformieren (BA — *• IRO), 

d) sowie in achsspezifische Darstellung umrechnen (Riicktransformation) 

e) Mit Hilfe der zweiten Position achsspezifische Geschwindigkeiten bestimmen (numerische Differentia- 
tion). 

55 6. Oberschleifsatz achsspezifisch aufbereiten. 

Der Obergang von greiferbezogener auf basisbezogene Interpolation wird anhand von Fig. 9 erlautert. 

Wieder wird zugunsten einer einfacheren zeichnerischen Darstellung eine konstante Orientierung zugrunde 
gelegt; die Algorithmen gelten jedoch allgemein. Man kann sich vorstellen, daB der in Fig. 8 eingeleitete 
so Bearbeitungsvorgang nach einmaliger Umrundung des Werkstucks beendet ist und nahtlos in einen basisbezo- 
gen programmierten Abtransport iibergeht (Fig. 9). 

Programmiert sind wieder die Punkte PI, P2 und P3 sowie ein Oberschleifkriterium, das den Beginn des 
Oberschleifens, Bl, festlegt. Der Abschnitt PI — P2 ist offenbar noch greiferbezogen angegeben, der Folgesatz, 
durch den Zielpunkt P3 definiert, dagegen relativ zu einem ortsfesten Bezugssystem BEZ, das nicht mit dem 
65 werkzeugfesten System BA ubereinstimmen muB. 

Wieder enthalt die Skizze sowohl die Bahn des Werkzeugs aus der Sicht eines Beobachters auf dem Greifer als 
auch die Bahn des Greifers, wie sie in einem ortsfesten Koordinatensystem erscheint. Der Startpunkt fur den 
Folgesatz muB anhand des greiferbezogen programmierten Zielpunktes des Vorgangersatzes berechnet wer- 
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den. Der Beginn des Oberschleifens ist ebenfalls noch in greiferfesten Koordinaten definiert, der Oberschleifsatz 
selbst wird jedoch nach Mogiichkeit im Bezugssystem des Folgesatzes aufbereitet, also entweder basisbezogen 
oder achsspezifisch. Demnach mussen die Positionen WO, Wl und W2 sowie die Geschwindigkeiten an den 
Punkten Wl und W2 im Bezugssystem BEZ oder im achsspezifischen Koordinatensystem bestimmt werden. 

Die nachfolgend qualitativ angegebenen Algorithmen fiir die Riickkehr zur basisbezogenen Bewegung stim- 
men weitgehend mit den ausschiieBIich basisbezogenen, bereits vorhandenen Versionen uberein. Die Unter- 
schiede sind durch Grautonung hervorgehoben. 

CP-CP 

Dieser Fall ist in der Skizze, Bild 12, dargestellt Folgesatz und Oberschleifsatz sollen basisbezogen, d. h. im 
Koordinatensystem BEZ, aufbereitet werden. Dies erfordert die folgenden Arbeitsschritte: 

1. Zieipunkt des Folgesatzes als basisbezogen erkennen. 

2. Startpunkt des Folgesatzes umrechnen: 

a) Startpunkt invertieren (ergibt WO relativ zu BA) 

b) und in das neue Bezugssystem transformieren (BA — ► BEZ). 

3. Folgesatz basisbezogen aufbereiten. 

4. Beginn des Oberschleifens im Vorgangersatz berechnen und transformieren: 

a) Oberschleifkriterium greiferbezogen auswerten, Position und Geschwindigkeiten berechnen (Bl relativ 
zu WZ). 

b) Ergebnis invertieren (ergibt Wl relativ zu BA), 

c) und ins Bezugssystem BEZ transformieren (BA — - BEZ). 

5. Ende des Oberschleifens berechnen: 

Oberschleifkriterium basisbezogen auswerten. Position und Geschwindigkeiten berechnen (W2 relativ zu 
BEZ). 

6. Oberschleifsatz basisbezogen aufbereiten. 

PTP-PTP 

Dies ist der einfachste Fall, da er sich uberhaupt nicht von einem gewdhnlichen PTP-PTP- Obergang mit 
Oberschleifen und Basiswechsel unterscheideL Der Zieipunkt des Vorgangersatzes ist relativ zum greiferfesten 
Koordinatensystem angegeben, aber von der Bewegungsplanung bereits auf achsspezifische Darsteilung umge- 
rechnet worden. Der Zieipunkt des Folgesatzes liegt in ortsfesten kartesischen oder in achsspezifischen Koordi- 
naten vor. Folgesatz und Uberschleifsatz sind achsspezifisch aufzubereiten. 

1. Zieipunkt des Folgesatzes als basisbezogen oder achsspezifisch erkennen. 

2. Zieipunkt des Folgesatzes auf achsspezifische Koordinaten umrechnen: 

a) Gegebene kartesische Position in roboterinterne Koordinaten transformieren (BEZ — * IRO). 

b) sowie in achsspezifische Darsteilung umrechnen (Riicktransformation). 

3. Folgesatz achsspezifisch aufbereiten. 

4. Beginn des Oberschleifens im Vorgangersatz berechnen: 

Oberschleifkriterium achsspezifisch auswerten. Position und Geschwindigkeiten berechnen. 

5. Ende des Oberschleifens berechnen: 

Oberschleifkriterium achsspezifisch auswerten, Position und Geschwindigkeiten berechnen. 

6. Oberschleifsatz achsspezifisch aufbereiten. 

CP-PTP 

Wieder liegt der Zieipunkt des Folgesatzes in ortsfesten Koordinaten oder sogar achsspezifisch vor. Sein 
Startpunkt muB allerdings daran angepaBt werden. Der Oberschleifsatz wird wie bei alien PTP-CP- und 
CP-PTP-Obergangen achsspezifisch berechnet. 

L Zieipunkt des Folgesatzes als basisbezogen oder achsspezifisch erkennen. 

2. Start- und Zieipunkt des Folgesatzes auf achsspezifische Koordinaten umrechnen: 

a) Startpunkt invertieren (ergibt WO relativ zu BA), 

b) in roboterinterne Koordinaten transformieren (BEZ — - IRO), 

c) und in achsspezifische Darsteilung umrechnen (Riicktransformation). 

d) Zieipunkt in roboterinterne Koordinaten transformieren (BEZ — IRO), 

e) sowie in achsspezifische Darsteilung umrechnen ( Riicktransformation). 

3. Folgesatz achsspezifisch aufbereiten. 

4. Beginn des Oberschleifens berechnen: 

a) Oberschleifkriterium greiferbezogen auswerten, zugehorige Position berechnen (Bl relativ zu WZ), 
auBerdem leicht verschobene, benachbarte Position. 

b) Beide Positionen invertieren (ergibt Wl relativ zu BA), 

c) in roboterinterne Koordinaten transformieren (BA — * IRO), 

d) sowie in achsspezifische Darsteilung umrechnen (Riicktransformation). 

e) Mit Hilfe der zweiten Position achsspezifische Geschwindigkeiten bestimmen (numerische Differentia- 
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tion). 

5. Ende des Oberschleifens im Folgesatz berechnen: 

Oberschleifkriterium achsspezifisch auswerten, Position und Geschwindigkeiten berechnen. 

6. Oberschleifsatz achsspezifisch aufbereiten. 

5 

PTP-CP 

In diesem Fall ist der Zielpunkt des Vorgangersatzes greiferbezogen programmiert und wurde bereits auf 
achsspezifische Koordinaten umgerechnet Der Startpunkt des basisbezogenen Folgesatzes kann also auf zwei 
10 Wegen gewonnen werden. Nur bei Verwendung der greiferbezogenen Angabe unterscheidet sich die Vorge- 
hensweise von einem gewohnlichen PTP-CP-Obergang. 

1. Zielpunkt des Folgesatzes als basisbezogen erkennen. 

2. Startpunkt des Folgesatzes umrechnen (Moglichkeit 1): 
15 a) Startpunkt invertieren (ergibt WO relativ zu BA) 

b) und in das neue Bezugssystem transformieren (BA — * BEZ). 
2. Startpunkt des Folgesatzes umrechnen (Moglichkeit 2): 

a) Achsspezifische Darstellung in roboterinterne kartesische Koordinaten transformieren (IRO), 

b) in das neue Bezugssystem umrechnen (IRO — + BEZ). 
20 3. Folgesatz basisbezogen aufbereiten. 

4: Beginn des Oberschleifens im Vorgangersatz berechnen: 

Oberschleifkriterium achsspezifisch auswerten, Position und Geschwindigkeiten berechnen. 
5. Ende des Oberschleifens berechnen: 

a) Oberschleifkriterium basisbezogen auswerten, zugehorige Position berechnen (W2 relativ zu BEZ), 
25 auBerdem leicht verschobene, benachbarte Position. 

b) in roboterinterne Koordinaten (IRO) transformieren, 

c) sowie in achsspezifische Darstellung umrechnen (Riicktransformation). 

d) Mit Hilfe der zweiten Position achsspezifische Geschwindigkeiten bestimmen (numerische Differentia- 
tion). 

30 6. Oberschleifsatz achsspezifisch aufbereiten. 

Mathematische Formulierung der Positions- und Geschwindigkeitstransformationen 

Im derzeitigen Ausbaustand der Steuerung sind nur Koordinatentransformationen zwischen ortsfesten Be- 
35 zugssystemen vorgesehen. Die greiferbezogene Interpolation erfordert jedoch auch Umrechnungen zwischen 
Koordinatensystemen, die sich relativ zueinander bewegen. Bei Positionen (dargestellt als homogene Matrizen) 
bringt dies nichts Neues, abgesehen von der Tatsache, daB alle Transformationsgleichungen nur noch momentan 
gelten, also in jedem Interpolationstakt neu ausgewertet werden mussen. 

Fur differenzierte GroBen, also zum Beispiel die translatorischen Geschwindigkeiten, gelten zwischen beweg- 
40 ten Koordinatensystemen vollig andere, aufwendigere Transformationsgleichungen. Dies muB bei der Umrech- 
nung der Randbedingungen von greiferbezogenen Oberschleifsatzen berucksichtigt werden. Hier sind Position, 
translatorische Geschwindigkeit und Winkelgeschwindigkeit zu transformieren. Die Gleichungen dafUr werden 
im folgenden aufgestellt. 

Zur Verdeutiichung seien die Transformationsgleichungen fur ortsfeste Koordinatensysteme kurz wiederholt. 
45 Fig. 10 zeigt zwei Bezugskoordinatensysteme Bl und B2 und eine beliebige Position, dargestellt durch den 
Ursprung und die Orientierung eines Koordinatensystems WZ, das sich mit der Geschwindigkeit v verschiebt 
und mit der Winkelgeschwindigkeit a> dreht. 

Die Lage der drei Koordinatensysteme relativ zueinander laBt sich sehr einfach durch homogene Transforma- 
tionen beschreiben, die in Fig. 10 ebenfalls angegeben sind. So beschreibt Twz B2 die Lage von WZ relativ zu B2. 
so 1st auBerdem die Lage von B2 relativ zu Bl bekannt, Tb2 B1 , erhalt man fur die Transformation der Position WZ in 
das Bezugskoordinatensystem Bl die bekannte Gleichung 

Twz B1 - Tb2 B1 T WZ B2 = (Tbi 32 )- 1 Twz B2 

55 Dabei werden in einem Schritt die Richtungen aller Koordinatenachsen von WZ und die Lage des Ursprungs 

von WZ in das neue Bezugssystem umgerechnet. ~~ 

Die Geschwindigkeitsvektoren v und co sind Richtungsvektoren, d. h. sie sind nicht an einen bestimmten Punkt 

gebunden, nur ihre Richtung interessierL Daher spielt bei der Transformation in ein anderes ortsfestes Koordi- 

natensystem nur dessen geanderte Orientierung eine Rolle, die Lage seines Ursprungs bleibt unberucksichtigt. 
60 1st zum Beispiel die translatorische Geschwindigkeit von WZ relativ zu B2 gegeben, v B2 , so berechnet man die 

Darstellung relativ zu Bt gemaB 

v Bl - R B2 B1 v B2 = (Rqi 82 )- 1 v B2 
65 Entsprechend gilt fur die Winkelgeschwindigkeit 
co B! = Rb2 BI co B2 = (Rbi 82 )- 1 03 B2 
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Darin bezeichnet Rb2 BI den Teil von Te2 B1 ,der die Orientierung von B2 relativ zu Bl angibt: 



R B 2 B1 B82 91 

0 0 0 1 



Transformation der programmierten Stiitzpunkte und Uberschleifpunkte 10 

Bei jedem Wechsel von einem basisbezogenen in das greiferbezogene Koordinatensystem und umgekehrt 
muB der Zielpunkt des Vorgangersatzes in das Koordinatensystem des Folgesatzes transformiert werden. Der 
Beginn von Oberschleifvorgangen zwischen CP-Satzen ist ebenfalls zu transformieren (Position, translatorische 
Geschwindigkeit und Winkelgeschwindigkeit). I5 

Fig. 1 1 zeigt die Situation beim Eintritt in einen CP-CP-Oberschleifsatz. Programmiert war der Zielpunkt WO, 
der bereits auf das Bezugssystem BA umgerechnet sei (mit Hilfe der Gleichungen fur die Transformation 
zwischen ortsfesten Koordinatensystemen). Die Position Two BA liegt also vor. Durch Auswertung des Ober- 
schleifkriteriums erhalt man ferner die Position zu Beginn des Uberschleifens, Wl. Lage und Orientierung an 
dieser Stelle seien ebenfalls bereits auf das Bezugssystem BA umgerechnet, man kennt also Twi BA (Geschwin- 20 
digkeit und Winkelgeschwindigkeit behandeln wir spater). 

Benotigt werden der Startpunkt und der Beginn des Uberschleifens relativ zum Greiferkoordinatensystem, 
also Tbo^ und Tbi wz . 

Die Skizze zeigt den Zeitpunkt To, zu dem das Greiferkoordinatensystem WZ die Position WO erreicht. WZ(xo) 
= WO. Gleichzeitig liegt vom Greifer aus gesehen das Basissystem BA an der Stelle BO, BA(xo) = BO. Demnach 25 
gilt 



Tbo wz = Tba wz (t 0 ) = (T Wj ba (to))-' = <Two BA )-' 

wie man aus der Skizze auch sofort abliest. 

Zu Beginn des Oberschleifens gilt entsprechend WZ(xi) = 

T B i wz = Tba wz (t,) = (Twz^t,))- 1 = (Twi BA )- 1 



30 

Wl und BA(xi) = Bl,also 



Dies mag bei einem Blick auf die Skizze nicht unmittelbar einleuchten. Man muB sich jedoch klarmachen, daB 35 
die Bahn des Basissystems BA aus Sicht des Greifers zu jedem Zeitpunkt die Bedingung Tba wz = (Twz BA )~ 1 
erfiillt, dies ist gerade die Vorschrift, anhand derer die Bahn gezeichnet wurde. Man kann sich vorstellen, daB 
zum Zeitpunkt xi das Greiferkoordinatensystem WZ gerade bei Wl liegt und das Basissystem BA unter genau 
dem Blickwinkel sieht, der dann zum spateren Zeitpunkt xo, etwas verschoben, eingezeichnet wurde (als Bl 
relativ zu WZ). 40 

Transformation der Geschwindigkeiten 

Zur Ableitung der Transformationsgleichungen dient Fig. 12. Der Unterschied zu Fig. 10 besteht darin. daB 
sich der Ursprung des Koordinatensystems B2 mit einer Geschwindigkeit vb2 relativ zu Bl bewegt und daB sich 45 
das System mit einer Winkelgeschwindigkeit a>B2 dreht (um eine Drehachse durch seinen Ursprung). Diese 
beiden Geschwindigkeiten kann man auch durch eine zeitlich veranderliche Transformation Tb2 B1 ausdrlicken. 

Vereinfachend betrachten wir jetzt nicht ein Koordinatensystem WZ, sondern nur einen Punkt P, der sich mit 
einer Geschwindigkeit vp relativ zu B2 bewegt. Diese Geschwindigkeit sei in B2-ICoordinaten bekannt, gesucht 
ist die Angabe in Bl-Koordinaten. 50 

v P B1 - f(yp B2 ). 

Ausgehend von der Gleichung fur die Koordinatentransforrnation des Punktes P, die zu jedem Zeitpunkt gilt. 
xp B1 - T B 2 B1 xp B2 , xp bi = [(r P ,Bi B! ) T , 1] T , 

erhalt man durch Differentiation nach der Zeit und nach einigen Umformungen [I] 

VP BI = V B 2 B! + tOB2 B1 Xrp,B2 Bl + RB2 Bl Vp B2 t 60 

was auch als "Satz von Coriolis" bekannt ist. 

Durch Anwendung dieses allgemeinen Ergebnisses auf einen speziellen Punkt, namlich den Ursprung von B I, 
folgt die benotigte Vorschrift fur die "Inversion" der translatorischen Geschwindigkeiten. Dazu ersetzt man alle 
Indizes P durch Bl, so daB folgt 65 

V B | B1 => V B 2 B1 + C0B2 B1 X IBl.B2 Bl + RB2 Bl V B 1 B2 , 



9 



DE 195 07 561 Al 



Die Geschwindigkeit des Ursprungs von Bl in Koordinaten von Bl, vbi B1 , ist Null. Schreibt man nun BA statt 
Bl und WZ statt B2, erhalt man 

0 - VWZ BA + C0W2 BA X £BA.W2 BA + R\VZ BA VBA WZ , 

5 

und nach der Geschwindigkeit des Ursprungs des Basissystems relativ zum Greiferkoordinatensystem aufgeldst 

v B a wz =- -(Rwz^g)" 1 (vwz BA + cowz BA x r BA ,wz BA ). 

10 Diese Gleichung eriaubt die Berechnung greiferbezogener translatorischer Geschwindigkeiten aus basisbezo- 
genen Positionen und Geschwindigkeiten, wird also beim Oberschleifen von basisbezogenen auf greiferbezoge- 
ne Satze bendtigt. Im einzelnen geht man aus von 

1 . Rwz BA Rotationsmatrix in Twz BA (*d), zu Beginn des Oberschleifens 
15 2. £ba,wz ba Vektor vom Ursprung von WZ zum Ursprung von BA, ausgedriickt in Koordinaten von BA 

3. vwz BA Geschwindigkeit des Greiferkoordinatensystems zu Beginn des Oberschleifens, relativ zu BA, 
ausgedriickt in Koordinaten von B A 

4. cowz BA Winkelgeschwindigkeit des Greiferkoordinatensystems zu Beginn des Oberschleifens, relativ zu 
BA, in Koordinaten von BA 

20 

und erhalt 

5. vba™ 2 Geschwindigkeit des Basissystems zu Beginn des Oberschleifens, relativ zum Greifer (WZ), 
ausgedriickt in Koordinaten von WZ. 

25 

Die umgekehrte Umrechnung fiir den Obergang von greiferbezogener auf basisbezogene Interpolation erhalt 
man am einfachsten durch formale Vertauschung der Indizes WZ und BA: 

VWZ BA - - (RbA^)" 1 (VBA^ + COBA^ X rwZ, B A W2 ). 

30 

Transformation der Winkelgeschwindigkeiten 

Die Transformation von Winkelgeschwindigkeiten gestaltet sich wesentlich einfacher, da Winkeigeschwindig- 
keitsvektoren sich ohne Rucksicht auf translatorische Geschwindigkeiten stets vektoriell addieren lassen. Man 
35 denke sich zwei Koordinatensysteme Bl und B2, die sich relativ zu einem feststehenden System BO mit den 
Winkelgeschwindigkeiten cdbi(bo) und cob2(Bo) drehen (Fig. 13 der eingeklammerte Index gibt an, daB die Drehun- 
gen relativ zu BO erf olgen). 

Da man vektoriell addieren darf, gilt 

40 <OB2(B0) = G>B1(B0) + <*>B2(B1) 
WBl(BO) — G>B2(B0) + <0B1(B2) 

und durch Einsetzen der ersten in die zweite Gleichung folgt 

45 C0 B 1(B2) — — B2(Bt) 

Fur die Herleitung wurde angenommen, daB alle Winkelgeschwindigkeiten im gleichen Koordinatensystem 
angegeben wurden, z. B. B0. Ist das nicht gewunscht, miissen die Koordinaten nach den RegeLn fiir ortsfeste 
Koordinatensysteme transformiert werden, z. B. 

50 

0>B1(B2) BO =» RB2 B0 WB1(B2) B2 ; WB2(B1) B ° » RBI 30 C0 B 2<B1) B1 

Einsetzen und Umformen liefert 

55 C0B1(B2) B2 - -^^-^Bl^^BlS) 31 = - Rbo B2 Rb1 B ° O^B!) 81 
= - RB1 B2 C0B2<B1) BI 

Setzt man nun noch BA fur Bl und WZ fur B2, folgt 

60 U>BA(WZ) WZ = — RBA WZ C0WZ<BA) BA 

oder in der abgekurzten Schreibweise des vorigen Abschnitts 
cdba* 2 = -Rba wz o>wz ba * - (Rwz^)- 1 cowz BA 

65 

Diese Gleichung eignet sich fiir eine Transformation basisbezogener in greiferbezogene GroBen. Die umge- 
kehrte Richtung erhalt man entweder durch Auflosen nach owz BA oder wieder durch formale Vertauschung der 
Indizes 
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0)WZ BA « - (RBA^r 1 <£BA WZ 

• Auswertung der Oberschleifkriterien 

Fur basisbezogene Bewegungssatze werden Beginn und Ende des Oberschleifens nach folgenden Regeln 
bestimmt: 

1. Bei PTP-CP und CP-PTP-Obergangen kommt im CP-Satz eines der bahnbezogenen Kriterien (C_DIS, 
C_ORI, C_SPEED) und im PTP-Satz ein achsspezifisches Kriterium (C_PTP) zur Anwendung. Oberschleif- 
beginn und -ende sind also jeweils durch eines der Kriterien genau festgelegt. 

2, In alien anderen Fallen werden die programmierten Kriterien nur auf den Beginn des Oberschleifens 
angewendet, das Ende wird mit Hilfe einer Symmetriebedingung fur Wege und Geschwindigkeiten berech- 
net: 

s(ti)/s(t 2 ) = v(xi)/v(T2) 

(ti Beginn, x 2 Ende des Oberschleifens) 

Der Vorteil dieses Verfahrens liegt darin, daB man bei LIN-LIN-Obergangen fiir die translatorischen 
Komponenten mit nur einer Oberschleifparabel auskommt. Andererseits entspricht die Form des Ober- 
schleifsatzes moglicherweise nicht den Wiinschen des Anwenders, da er das Ende des Oberschleifens nur 
indirekt beeinflussen kann. 

Das Oberschleifen zwischen greiferbezogenen Satzen kann grundsatzlich auf die gleiche Weise abgewickelt 
werden. An den Schnittstellen zu den basisbezogenen Satzen allerdings konnte die Symmetriebedingung zur 
Bestimmung des Oberschleif-Endes Schwierigkeiten machen. Durch den Wechsel von einem ortsfesten auf ein 
bewegtes Koordinatensystem und umgekehrt mussen die Randbedingungen eines der beiden Bewegungssatze 
transformiert werden, um die Symmetriebedingung uberhaupt anwenden zu konnen. Dieser transformierte Satz 
wird unter Umstanden stark verzerrt gesehen, insbesondere, wenn er Orientierungsanderungen enthalt. Da- 
durch ist fiir den Anwender schwer vorhersehbar, an welcher Stelle der Oberschleifvorgang endet. Insbesondere 
beim Oberleiten auf greiferbezogene Interpolation, wo der Beginn des Oberschleifens basisbezogen program- 
miert wird, das Ende aber noch sicher vor dem Beginn der Kontur liegen muB (Fig. 8 ), kann man eben dies nicht 
garantieren. 

Die sauberste Losung dtirfte darin bestehen, das programmierte Oberschleifkriterium grundsatzlich auch fiir 
die Bestimmung des Oberschleif-Endes zu benutzen, wie es bei PTP-CP-Obergangen ohnehin praktiziert wird. 
Dies fuhrt zu einer einheitlichen, gut tiberschaubaren Losung. An der Schnittstelle zwischen basisbezogenen und 
greiferbezogenen Satzen muB man auBerdem davon ausgehen, daB in dem Koordinatensystem, in dem der 
Uberschleifsatz berechnet wird, der Vorgangersatz meist wie ein Zirkularsatz aussieht. Somit muB man den 
Oberschleifsatz sowieso aus zwei Parabeln zusammensetzen und wurde von der Symmetriebedingung gar nicht 
mehr profitieren. 

Wechsel der Bezugssysteme in greiferbezogenen Satzen 

Durch die Interpolation der Bewegung des Basissystems relativ zum Greifer vertauschen diese Koordinaten- 
systeme ihre Rolle vollstandig, auch im Hinblick auf das Oberschleifen. Im Unterschied zur basisbezogenen 
Bewegung ist nunmehr ein Wechsel des Basissystems BA (SBASE) mit einer sprungformigen Veranderung des 
Arbeitspunktes gleichzusetzen (wie sonst ein Wechsel von $TOOL) und daher zwischen CP-Satzen nicht 
uberschleiffahig. Dagegen entspricht ein Wechsel des Greiferkoordinatensystems (gegeben durch $TOOL) nur 
einer Anderung des Bezugspunktes fur den nachsten Zielpunkt und beeintrachtigt das Oberschleifen nicht 

Im folgenden sei der Ansatz fiir die Realisierung der greiferbezogenen Interpolation nochmals zusammenfas- 
send dargestellt: 

a) der Ursprung des Greiferkoordinatensystems wird in den Tool Center Point im folgenden TCP der 
Roboterhand des Basiskoordinatensystems in das ortsfeste Werkzeug gelegt. 

b) Greiferbezogene kontinuierliche Bahnbewegungen, sogenannte Continuous Path-Satze, im folgenden 
CP-Satze werden greiferbezogen aufbereitet und interpoliert und der Riickwartstransformation invertiert. 

c) Greiferbezogene Punkt-zu-Punkt-Bewegungen sogenannte PTP-Satze werden achsspezifisch aufberei- 
tet und interpoliert. 

Liegt der Zielpunkt des PTP-Satzes in kartesischen Koordinaten vor so invertiert die Preparation den 
Zielpunkt und transformiert diesen in achsspezifische Koordinaten. Die achsspezifische Interpolation bieibt 
gegenuber der basisbezogenen Interpolation unverandert. 

Der Losungsansatz fiir das Oberschleifverfahren basiert auf Methoden, die bereits bei der basisbezogenen 
Interpolation zur Anwendung kommen. Das Oberschleifverfahren der basisbezogenen Interpolation stellt einen 
stetigen Obergang der vektoriellen Translation und Orientierungsgeschwindigkeiten zwischen Einzelsatzen 
sicher. Die meisten Anderungen gegenuber der basisbezogenen Interpolation entstehen in der Profilaufberei- 
tung und zwar bei der Anpassung der Staat und Zielpunkte der Einzel- und Oberschleifsatze sowie bei der 
Transformation der translatorischen Geschwindigkeit und der Winkelgeschwindigkeiten bei CP-CP-Obergan- 
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gen. 

Grundsatzlich ist der Oberschleifsatz zum Koordinatensystem des Folgesatzes zu praparieren, cL h. der 
Wechsel zwischen basis- und greiferbezogener Interpolation erfolgt bereits zu Beginn des Oberschleifens. Eine 
Ausnahme machen nur PTP-PTP, FTP-CP bzw. CP-PTP-Satze, da diese achsspezifisch aufbereitet werden 
milssen. Im einzelnen ergeben sich Unterschiede in der Profilerzeugung gegenuber dem basisbezogenen Ober- 
schleifverfahren. 

Patentanspruche 

1. Verfahren zum Oberschleifen bei Wechsel von basisbezogener auf greiferbezogene Interpolation und 
umgekehrt, dadurch gekennzeichnet, daB der Ursprung eines Greiferkoordinatensystems (WZ) in die 
Roboterhand (Tool-Center Point, TCP), das Basiskoordinatensystem (BA) in das ortsfeste Werkzeug (W) 
gelegt wird, und daB greiferbezogene Verfahrsatze greiferbezogen aufbereitet und interpoliert und vor der 
Transformation vom kartesischen in das Achskoordinatensystem invertiert werden. 

2. Verfahren nach Anspruch 1 filr den Obergang von einem basisbezogen interpolierten kontinuierlichen 
Verfahrsatz (Continuous Path CP) auf einen greiferbezogenen interpolierten kontinuierlichen Verfahrsatz 
(CP), wobei 

a) der Startpunkt des Folgesatzes und der Startpunkt des Oberschleifsatzes in das Greiferkoordinaten- 
system transf ormiert und 

b) der Folge- und der Oberschleifsatz greiferbezogen aufbereitet werden. 

3. Verfahren nach Anspruch 1 fur den Obergang von einem basisbezogen interpolierten kontinuierlichen 
Verfahrsatz (CP) auf einen greiferbezogen interpolierten linearen Verfahrsatz (PTP), wobei 

a) der Zielpunkt des Folgesatz in das Basiskoordinatensystem transformiert und in achsspezifische 
Koordinaten umgerechnet wird, 

b) der Folge- und Oberschleifsatz achsspezifisch aufbereitet wird. 

4. Verfahren nach Anspruch 1 filr den Obergang von einem basisbezogenen interpolierten linearen Verfahr- 
satz (PTP) auf einen greiferbezogen interpolierten kontinuierlichen Verfahrsatz (CP) wobei 

a) der Startpunkt des Folgesatzes zunachst in das Basiskoordinatensystem und dann Uber eine Matrix- 
inversion in das Greiferkoordinatensystem transformiert wind 

b) der Folgesatz greiferbezogen aufbereitet wird. 

5. Verfahren nach Anspruch 1 fur den Obergang von einem basisbezogen interpolierten linearen Verfahr- 
satz (PTP) auf einen greiferbezogen interpolierten linearen Verfahrsatz (PTP), wobei 

a) der Zielpunkt des Folgesatzes in das Basissystem transformiert wird und in achsspezifische Koordi- 
naten umgerechnet wird 

b) der Folgesatz und der Oberschleifsatz basisbezogen aufbereitet werden. 

6. Verfahren nach Anspruch 1 fur den Obergang von einem greiferbezogen interpolierten kontinuierlichen 
(CP) Verfahrsatz auf einen basisbezogen interpolierten kontinuierlichen Verfahrsatz (CP) wobei 

a) der Startpunkt des Folgesatzes und der Startpunkt des Oberschleifsatzes in das Basiskoordinatensy- 
stem transformiert werden 

b) der Beginn des Oberschleifens durch greiferbezogene Auswertung des Oberschleifkriteriums ermit- 
teltwird 

c) Folgesatz und Oberschleifsatz basisbezogen aufbereitet werden. 

7. Verfahren nach Anspruch 1 fur den Obergang von einem greiferbezogen interpolierten kontinuierlichen 
(CP) Verfahrsatz auf einen basisbezogen interpolierten linearen Verfahrsatz (PTP), wobei 

a) der Startpunkt des Folgesatzes in das Basiskoordinatensystem transformiert und in achsspezifische 
Koordinaten umgerechnet wird, 

b) das Oberschleifkriterium zur Bestimmung des Startpunkts des Oberschleifsatzes greiferbezogen 
ausgewertet, die dazugehorige Position invertiert und in achsspezifische Koordinaten umgerechnet 
wird, 

c) Folgesatz und Oberschleifsatz achsspezifisch aufbereitet werden. 

8. Verfahren nach Anspruch 1 fur den Obergang von einem greiferbezogen interpolierten linearen (PTP) 
Verfahrsatz auf einen basisbezogen interpolierten kontinuierlichen Verfahrsatz (CP) wobei 

a) der Startpunkt des basisbezogenen Folgesatzes in das Basiskoordinatensystem (BA) umgerechnet 
wird 

b) der Oberschleifsatz basisbezogen aufbereitet wird. 
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Bild 12: Uberschleifen bei Ubergang von greiferbezogener auf 

basisbezogene Interpolation 
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Bild 14: Transformation der Stutzpunkte und Oberschleifpunfcte 
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Bild 15: Transformation einer translatorischen Geschwindigkeit zwischen 

bewegten Koordinatensystemen 
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Bild 16: Transformation einer Winkelgeschwindlgkeit zwischen bewegten 

Koordinatensystemen 
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LI ANSWER 1 OF 1 WPINDEX COPYRIGHT 2004 THOMSON DERWENT on STN 

TI Position transformation method for numerically controlled machines - 

involves providing mathematical transformation between tool clamp and tool 

piece position to allow continuous drawn movement. 
PI DE 19507561 Al 19950914 (199542)* 12p B25J009-18 <-- 

AB DE 19507561 A UPAB : 19951026 

The method involves a change from a base reference to a tool clamp 

reference interpolation and back again. It establishes a transformation 

between a tool clamp coordinate system (WZ) in the robot hand (TCP), and a 

base coordinate system (BA) in the tool piece (W) . 

Mathematical interpolation procedures are applied to the tool clamp 

reference and then inverted, before the transformation from cartesian to 

axial coordinates. 

ADVANTAGE - Permits continuous welding and gluing processes. 
Dwg.6/13 



